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Abstract  A  novel  integrated  guidance  and  autopilot  design  method  is  proposed  for  homing  mis¬ 
siles  based  on  the  adaptive  block  dynamic  surface  control  approach.  The  fully  integrated  guidance 
and  autopilot  model  is  established  by  combining  the  nonlinear  missile  dynamics  with  the  nonlinear 
dynamics  describing  the  pursuit  situation  of  a  missile  and  a  target  in  the  three-dimensional  space. 
The  integrated  guidance  and  autopilot  design  problem  is  further  converted  to  a  state  regulation 
problem  of  a  time-varying  nonlinear  system  with  matched  and  unmatched  uncertainties.  A  new 
and  simple  adaptive  block  dynamic  surface  control  algorithm  is  proposed  to  address  such  a  state 
regulation  problem.  The  stability  of  the  closed-loop  system  is  proven  based  on  the  Lyapunov  the¬ 
ory.  The  six  degrees  of  freedom  (6DOF)  nonlinear  numerical  simulation  results  show  that  the  pro¬ 
posed  integrated  guidance  and  autopilot  algorithm  can  ensure  the  accuracy  of  target  interception 
and  the  robust  stability  of  the  closed-loop  system  with  respect  to  the  uncertainties  in  the  missile 
dynamics. 
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1.  Introduction 


The  traditional  design  method  of  the  missile  guidance  and 
autopilot  system  is  to  design  each  subsystem  separately  and 
then  integrate  them.  In  order  to  achieve  the  desired  overall  sys¬ 
tem  performance,  modifications  are  generally  inevitably  re¬ 
quired  to  each  subsystem.  Hence  such  a  design  approach 
usually  leads  to  excessive  design  iterations  and  high  costs. 
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What’s  more,  it  is  argued  that  this  approach  may  not  fully  ex¬ 
ploit  the  synergistic  relationships  between  these  two  interacting 
subsystems.  As  a  result,  the  performance  of  the  overall  system 
may  be  constrained.1,2 

To  overcome  this  problem,  a  new  design  method  called 
integrated  guidance  and  autopilot  was  proposed.  Integrated 
guidance  and  autopilot  directly  generates  the  fin  deflection 
commands  according  to  the  states  of  the  missile  and  the  target 
relative  to  the  missile  to  drive  the  missile  to  intercept  the  tar¬ 
get.1  In  the  integrated  guidance  and  autopilot  system,  there 
is  no  separation  between  guidance  and  autopilot.2  Therefore, 
the  synergistic  relationships  between  the  coupled  subsystems 
can  be  fully  exploited  to  optimize  the  performance  of  the  over¬ 
all  system.  Due  to  this  reason,  integrated  guidance  and  autopi¬ 
lot  has  received  more  and  more  attention  recently. 1-10 

However,  most  of  the  existing  relevant  literature  is  on  the 
three-channel  independent  design  idea  and  is  focused  on  the 


1000-9361  ©  2013  Production  and  hosting  by  Elsevier  Ltd.  on  behalf  of  CSAA  &  BUAA. 
http://dx.doi.Org/10.1016/j.cja.2013.04.035 


742 


M.  Hou  et  al. 


Nomenclature 

a 

angle  of  attack  (rad) 

R 

missile-target  range  (m) 

P 

angle  of  sideslip  (rad) 

r 

missile-target  range  in  horizon  plane  (m) 

y 

roll  angle  (rad) 

Cx  o 

zero-lift  drag  coefficient 

t 

yaw  angle  (rad) 

<f.,  cP 

partial  derivatives  of  drag  force  coefficient  with 

■d 

pitch  angle  (rad) 

respect  to  a  and  p 

e 

flight  path  angle  (rad) 

l2  partial  derivatives  of  drag  force  coefficient  with 

tv 

heading  angle  (rad) 

respect  to  bx,  by  and  5Z 

(Ox,  OOy,  (O. 

j  body-axis  roll,  yaw  and  pitch  rates  (rad/s) 

cf 

second  partial  derivative  of  drag  force  coeffi¬ 

5X,  by,  Sz 

aileron,  Rudder  and  elevator  deflections  (rad/s) 

cient  with  respect  to  a  and  P 

V 

velocity  of  the  missile  (m/s) 

Cy,Cy,C6y* 

partial  derivatives  of  lift  force  coefficient  with 

m 

mass  of  the  missile  (kg) 

respect  to  a,  P  and  <5Z 

P 

thrust  force  (N) 

partial  derivatives  of  side  force  coefficient  with 

P 

air  density  (kg/m3) 

respect  to  a,  p  and  <5V 

q  =  0.5 pV~  dynamic  pressure  (Pa) 

rr%,n?x,; 

partial  derivatives  of  rolling  moment  coeffi¬ 

JX,  Jy,  Jz 

roll,  yaw  and  pitch  moments  of  inertia  (kg  m2) 

cient  with  respect  to  bx,  a.  and  /? 

X,  Y,Z 

drag,  lift  and  side  forces  (N) 

nfi  ,my 

partial  derivatives  of  yawing  moment  coefficient 

S 

reference  area  (m2) 

with  respect  to  P  and  by 

L 

reference  length  (m) 

partial  derivatives  of  pitching  moment  coeffi¬ 

n 

elevation  angle  of  the  line-of-sight  (rad) 
azimuth  angle  of  the  line-of-sight  (rad) 

cient  with  respect  to  a  and  bz 

integrated  guidance  and  autopilot  design  when  the  missile  and 
the  target  only  move  in  the  same  plane.  Only  a  few  of  them 
consider  the  coupled  relationships  among  different  channels 
of  the  missile  dynamics,  which  in  fact  can  also  be  exploited 
to  improve  the  performance  of  the  overall  system.  In  the  recent 
literature,  some  control  methods  like  feedback  linearization 
method,1  nonlinear  optimal  control  method  including  state- 
dependent  Riccati  equation  (SDRE)  method2’8  and  0-D  meth¬ 
od,9  etc.,  have  been  applied  to  the  integrated  guidance  and 
autopilot  framework  where  the  full  nonlinear  missile  dynamics 
is  used.  But  these  methods  all  involve  complicated  numerical 
computations.  For  example,  in  the  feedback  linearization 
method,1  complicated  numerical  computations  are  required 
to  transform  the  nonlinear  system  into  a  linear  system,  and 
then  the  linear  control  method  is  used;  in  the  nonlinear  optimal 
control  method,2,8,9  it  is  needed  to  solve  the  Hamilton-Jacco- 
bi-Bellman  (HJB)  equation  on-line,  hence  complicated  numer¬ 
ical  calculations  are  also  unavoidable.  What  is  more,  these 
methods  cannot  ensure  the  robustness  of  the  closed-loop  sys¬ 
tem.  Therefore,  it  is  necessary  and  interesting  to  develop  sim¬ 
ple  and  effective  fully  integrated  guidance  and  autopilot 
algorithms  with  good  performance  and  stability  robustness. 

In  the  current  paper,  an  integrated  guidance  and  autopilot 
algorithm  is  proposed  for  a  kind  of  homing  missiles  at  the 
stage  of  diving  to  attack,  that  is,  the  passive  homing  phase. 
This  kind  of  missiles  is  used  to  attack  ground  targets  and 
adopt  the  skid-to-turn  (STT)  technology.  First  of  all,  the  inte¬ 
grated  guidance  and  autopilot  model  is  established  by  combin¬ 
ing  the  nonlinear  missile  dynamics  with  the  nonlinear 
dynamics  describing  the  pursuit  situation  of  a  missile  and  a 
target  in  the  three-dimensional  space.  As  a  result,  the  inte¬ 
grated  guidance  and  autopilot  design  problem  is  converted 
to  a  state  regulation  problem  of  a  time-varying  nonlinear  sys¬ 
tem  with  matched  and  unmatched  uncertainties.  Fortunately, 
this  model  satisfies  the  so-called  block  low-triangular  struc¬ 
ture,  which  makes  it  possible  to  design  the  control  algorithm 
utilizing  the  block  backstepping  methodology.11  However, 


the  block  backstepping  methodology  suffers  from  the  problem 
of  “explosion  of  complexity”  arising  from  the  repeated  differ¬ 
entiations  of  the  virtual  controls.  As  a  consequence,  the  com¬ 
plexity  of  the  control  algorithm  grows  drastically  as  the  order 
of  the  system  increases.  To  avoid  such  a  problem,  a  block  dy¬ 
namic  surface  control  approach  is  proposed  in  this  paper  by 
introducing  a  set  of  first-order  filters  at  each  step  of  the  tradi¬ 
tional  block  backstepping  approach. 

The  proposed  adaptive  block  dynamic  surface  control  ap¬ 
proach  can  be  viewed  as  an  extension  of  the  traditional  dy¬ 
namic  surface  control  approach.10’12-14  The  stability  analysis 
of  the  closed-loop  system  is  also  given  based  on  the  Lyapunov 
theory.  The  six  degrees  of  freedom  (6DOF)  nonlinear  numeri¬ 
cal  simulation  results  show  that  the  proposed  feedback  con¬ 
troller  can  ensure  the  accuracy  of  target  interception  and  the 
robust  stability  of  the  closed-loop  system  with  respect  to  the 
inevitable  uncertainties  in  the  missile  dynamics. 

2.  Problem  formulation 

In  this  section,  the  integrated  model  of  the  missile  guidance 
and  autopilot  system  is  firstly  established.  Then,  the  control 
design  objective  of  this  paper  is  presented. 

2.1.  Model  derivation 

The  nonlinear  missile  dynamics  with  uncertainties  is  described 
by15’16 

*i  =f{xi)+gi{#,xi)x2  +  di(t) 

X2=f2(xux2)+g2(t)u  +  d2(t) 

'?]  M  p/ 

*1  =  P  ,  X2=  Wy  ,  u  =  5y 

cx  J  |_®J 
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0 
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where  the  dynamics  of  the  pitching  angle  is  given  by 


=  Wy  sin  y  + , 


7 


(2) 


and  d\(t)  and  d2(t)  are  the  uncertain  terms  cased  by  the  uncer¬ 
tainties  of  the  missile-related  parameters,  for  example,  the 
aerodynamic  coefficients,  etc. 

On  the  other  hand,  as  shown  in  Fig.  1,  the  pursuit  situation 
of  a  missile  and  a  target  in  the  three-dimensional  space  can  be 
described  by  the  following  nonlinear  differential  equations18,19: 


R-  Ri?  -  Rq2  cos  2s 

'a4x 

2 Re  +  Re  +  rrj2  sin  s 

= 

at4y 

- 

a4y 

-2 Rq  cos  s  —  rq  +  2 Rfjk  sin  g 

_  Ot4z  _ 

where  at4  =  [al4x  al4y  at 4-]T  is  the  acceleration  vector  of  the 
target  in  the  line-of-sight  (LOS)  coordinate  system, 
a4  =  [a4x  a4y  a4z]  r  the  acceleration  vector  of  the  missile  in 
the  LOS  coordinate  system.  From  Eq.  (3),  one  has 


(4) 


The  acceleration  components  of  the  missile  along  the  z-  and 
y-axes  of  the  missile  velocity  coordinate  system  are  given  by17 


where  Y  and  Z  are  given  by 


Z  =  qScf‘fl  +  dz 
Y  =  qScya  +  dY 


(5) 

(6) 


where  dz  and  dY  are,  respectively,  the  side  force  and  lift  force 
caused  by  the  other  factors,  for  example,  the  control  surfaces, 
etc.  Each  of  these  two  terms  is  much  smaller  than  its  left  term 
in  the  right  side  of  the  above  equations.  So  dz  and  dY  can  be 
considered  as  uncertain  terms.  When  a  and  [i  are  small  enough, 
we  have  sin  a  ss  a,  sin  /?  Ri  /?  and  cos  1.  Then  from  Eq.  (6), 
one  can  obtain 


(7) 


where  [c/3z  d^  represents  the  approximation  errors  between 
[«3z  a3)]r  and  the  first  term  on  the  right  side  of  Eq.  (7). 

If  the  missile  flies  heading  to  the  target  at  initial  time  (this 
can  be  satisfied  in  many  cases),  then  the  missile  velocity  coor¬ 
dinate  system  approximately  coincides  with  the  LOS  coordi¬ 
nate  system.  As  a  result,  one  has 


where  [d4z  d4l\'  represents  the  approximation  errors  between 
[«4z  a4y]T  and  [a3z  a3JT. 

Define 


*oi  =  i),  *02  =  8 


then  combining  Eqs.  (7)  and  (8)  with  Eq.  (4),  we  have 
*0  =/o(*o)  +£o(0*f  +  4>(0  (9) 

where 


and  d0(t)  represents  the  uncertainty. 

According  to  the  above  analysis,  the  integrated  model  of 
the  guidance  and  autopilot  system  for  homing  missiles  can 
be  written  as 


r  *0  =/o(*o)  +g0(t)xf  +  d0(t) 

<  *1  =fi(xi )+g1(i7, *0*2  +  di(t)  (10) 

[  *2  =f2(xux2)  +g2(t)u+  d2{t) 

In  this  paper,  the  uncertainties  d0(t),  d\(t)  and  d2(t)  are  as¬ 
sumed  to  satisfy  Assumption  1. 

Assumption  1.  There  exist  a  set  of  unknown  constants  p, 
(j  =  0, 1,2)  such  that 
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urn  <  Pi 

System  (10)  is  a  time- varying  nonlinear  system  with  un¬ 
matched  uncertainties  d0(t )  and  djt),  and  matched  uncertainty 
d2(t).  Here  it  is  assumed  that  these  uncertainties  are  all  norm- 
bounded,  but  the  bounds  are  unknown. 

It  is  noted  that  when  the  missile  is  close  to  the  target  en¬ 
ough,  the  seeker  will  operate  in  its  dead  zone;  as  a  result,  the 
integrated  guidance  and  autopilot  system  will  not  work  any¬ 
more.  Hence,  we  just  need  to  consider  the  situation  when 
r  ^  rf,  or  equivalently,  R  ^  Rf,  where  r{  and  Rf  are  two  posi¬ 
tive  numbers  related  to  the  dead  zone  of  the  seeker.  In  this 
case,  g0(t)  is  well  defined  since  m  >  0.  Furthermore,  we  assume 
that  g0(t)  satisfies  Assumption  2  below. 

Assumption  2.  The  elements  of  g0(t)  and  g0  1 2 3 4  (t)  together  with 
their  derivatives  are  all  bounded. 

This  assumption  will  be  used  in  the  stability  analysis  of  the 
closed-loop  system. 

Simple  computation  yields 

det(gj  (d,  jc i ))  =  cos  a  +  (cos  y  sin  a  +  tan  /?  sin  y)  tan  d 
hence  Lemma  1  is  immediate. 

Lemma  1.  There  exist  three  positive  constants 

0  <  am  <  ^ ,  0  <  )3m  <  ^ 
m  2  2  ’  2 

such  that  g |  is  invertible  for  arbitrary  variable  y  and 
(a,/Ld)6{(a:/Ld):>;  <  am,|/J|  <  jBm,|0|  «  <>»} 

According  to  Lemma  1,  we  give  Assumption  3  which  is  use¬ 
ful  in  the  sequential  control  design  and  analysis  process. 

Assumption  3.  Throughout  the  engagement,  the  relationship 

(xJ,d)£B2  =  {(«J,d):\ot\  <  «m,  |jS|  <  /3m,\d\  <  tfm} 

always  holds. 

Assumption  3  is  mainly  used  to  ensure  that  gi  is  invertible, 
since  the  inverse  of  g\  will  be  used  in  the  proposed  integrated 
guidance  and  autopilot  algorithm.  In  most  cases,  this  assump¬ 
tion  can  be  satisfied.  However,  whether  this  assumption  is 
really  satisfied  can  only  be  verified  when  am,  fim  and  dm  are  ob¬ 
tained  from  the  simulation  results. 

2.2.  Design  objective 

In  this  paper,  the  main  guidelines  for  the  design  of  the  inte¬ 
grated  guidance  and  autopilot  algorithm  are  given  as  follows: 

(1)  To  intercept  the  maneuvering  targets  with  small  miss 
distance. 

(2)  To  maintain  the  change  of  the  roll  angle  near  zero 
throughout  the  engagement. 

(3)  To  stabilize  the  states  of  the  missile. 

(4)  To  be  robust  with  respect  to  the  inevitable  uncertainties 
existing  in  the  missile  dynamics.  That  is  to  say,  the  above 
three  guidelines  should  also  be  satisfied  when  there  exist 
uncertainties  in  the  missile  dynamics. 


According  to  the  parallel  approaching  method,20  to  acquire 
a  zero  miss-distance,  the  LOS  direction  should  be  kept  con¬ 
stant  ultimately.  Hence,  to  satisfy  the  first  guideline,  h  and  s 
should  be  driven  to  zero  as  much  as  possible.  The  second 
guideline  can  be  satisfied  by  maintaining  the  roll  angle  y  near 
zero  throughout  the  engagement  if  the  initial  roll  angle  is  set 
as  zero.  And  the  third  guideline  requires  that  the  states  of 
the  missile  should  be  kept  bounded  (Strictly  speaking,  each 
one  of  the  states  should  be  kept  in  a  reasonable  bound,  but  this 
problem  is  too  difficult  to  be  solved  at  present). 

Therefore,  the  integrated  guidance  and  autopilot  algorithm 
design  problem  can  be  viewed  as  the  state  regulation  problem 
of  the  uncertain  nonlinear  system  (10),  that  is,  to  propose  an 
appropriate  control  algorithm  for  system  (10)  not  only  to  drive 
its  partial  states  x0\  (i.e.,  rj),  x02  (i.e.,  e)  and  xn  (he.,  y)  (xy  re¬ 
fers  to  the  /th  element  of  the  state  vector  xj)  to  zero  as  much  as 
possible,  but  also  to  ensure  that  all  the  states  of  the  closed-loop 
system  are  kept  bounded. 

3.  Control  design  and  stability  analysis 

In  this  section,  an  adaptive  block  dynamic  surface  control 
algorithm  is  developed  for  the  uncertain  nonlinear  system 
(10)  which  can  drive  the  states  x0i,  x02  and  xn  into  a  neighbor¬ 
hood  of  zero,  and  keep  the  other  states  bounded 
simultaneously. 

3.1.  Control  algorithm 


System  (10)  is  a  time-varying  nonlinear  system  with  matched 
and  unmatched  uncertainties.  For  such  a  kind  of  nonlinear 
systems,  the  most  natural  control  method  is  the  block  back- 
stepping  approach  since  the  system  satisfies  the  so-called  block 
low-triangular  structure.  But  the  traditional  block  backstep- 
ping  methodology  suffers  from  the  problem  of  “explosion  of 
complexity”  arising  from  the  repeated  differentiations  of  the 
virtual  controls.  To  avoid  this  problem,  an  adaptive  block  dy¬ 
namic  surface  controller  is  given  as  follows: 


*o  =  *0 

xtd  =  -tfS'HOOMo  +/o(*o))  +  k0s0 
Tii*  +  xfc  =  xfd 


Xu  =gx  1  {d,  Xi)  /q.s'i  -  k\S\  -f(x i)  4 

XlX-lc  +  Xu  =  Xu 
S2=X2~  X2c 

“  =  gjl{t){-k2S2  ~  H2S2  ~f2{x l ,  X2)  +  *2c) 


[4]) 


where  s0,  .v,  and  s2  are  the  dynamic  surface  vectors;  k0  =  di- 
ag(/c0i,  k02),  kl  =  diag(/t|  h  kl2,  kl3)  and  k2  =  diag(/v2[,  k22, 
k23 )  denotes  the  dynamic  surface  gain  matrices,  whose  ele¬ 
ments  are  called  the  dynamic  surface  gains;  the  control  algo¬ 
rithm  includes  three  steps  starting  from  s0,  .v,  and  s2, 
respectively;  xfA  and  jc2d  (where  the  index  “d”  means  “de¬ 
sired”)  are  the  virtual  control  vectors  obtained  from  the  first 
and  the  second  steps;  and  x2c  (where  the  index  “c”  means 
“command”)  are  the  command  inputs  of  the  second  step  and 
the  third  step,  which  are  obtained  by  letting  xfA  and  x2d. 
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respectively,  pass  through  a  set  of  low  pass  filters  (i.e.,  the  third 
and  the  sixth  equations  of  the  control  algorithm  (1 1));  Ti  =  di- 
ag(t,  i,  x 1 2)  and  x2  =  diag(r2i,  r22,  *23)  denote  the  filter  time 
constant  matrices,  whose  elements  are  called  the  filter  time 
constants;  p,  is  the  estimate  of  p,  and  satisfies  the  following 
updating  law 

h  =  -  <W*t)  (12) 


then 

x*  =  sf  +  x*  =  sf  +  Vl  +  x*A  (25) 

Simple  computations  yield  that 
So  =  Xo  =f)+  goxf  +  d0 

=  So  {sf  +  Jh )  -  /Vo  +  £0*0*0  +  d0  (26) 


where  A,  and  cr,  are  positive  design  parameters. 

Remark  1.  If  let  T\  =  0  and  t2  =  0,  then  xfc  =  xfd  and 
x2  c  =  x2d;  as  a  result,  the  control  algorithm  (11)  becomes  the 
traditional  block  backstepping  control  approach.  In  this  case, 
it  is  necessary  to  compute  the  differentiations  of  the  virtual 
controls  repeatedly,  which  will  result  in  a  complex  control 
algorithm.  In  our  algorithm,  by  introducing  two  sets  of  filters, 
the  repeated  differentiations  of  the  virtual  controls  are 
avoided.  In  addition,  it  is  noted  that  the  derivatives  of  the 
command  inputs  can  be  obtained  by  simple  algebraic  manip¬ 
ulations  as  follows: 

4  =  4(4-4)  (13) 

x2c  =  (x2d  —  X&)  (14) 

Remark  2.  Compared  to  the  existing  integrated  and  autopilot 
algorithms  based  on  the  feedback  linearization  or  the  nonlin¬ 
ear  optimal  control  method,  the  proposed  integrated  guidance 
and  autopilot  algorithm  (1 1)  is  very  simple  and  analytic,  avoid¬ 
ing  complicated  computations. 


*i  =  *1  - 


=  — -  #,*,  +#i(s2  +  j>2)  +  d  1 


(27) 


s2  =  x2-  X2c  =/2  +  g2U  +  d2-X 2c  =  *2*2  -  #2*2  +  d2  (28) 


Similar  to  the  existing  literature  on  the  dynamic  surface 
control  approach,  for  example  Ref.  13,  etc.,  here  the  closed- 
loop  dynamics  can  be  expressed  in  terms  of  the  dynamic  sur¬ 
face  vectors,  the  boundary  layer  error  vectors  and  the  estimate 
error  vectors.  That  is  to  say,  the  closed-loop  dynamics  can  be 
expressed  by  Eqs.  (17),  (18),  (19),  (26),  (27)  and  (28),  or 
equivalently, 

*o  =  #o(*f  +  Ti)  -  #o*o  +  #0*0*0  +  do 

si  =  -#i*i  -£ii*i  T #i(*2  T Jh)  +d\ 

*2  =  -*2*2  -  #2*2  +  d2 

#i  =  -  4 

h  =  ~4#2  -  X2i 

Ji  =  -l,(sJsi-Wi)  (i=  0,1,2) 


Define  the  candidate  Lyapunov  function  as 


3.2.  Stability  analysis 

For  simplification,  a  function  f[)  will  be  denoted  by  /in  the 
following  process. 

Define  the  boundary  layer  error  vectors  as 


then 


(30) 


y2  =  *2c  -  *2d 

and  the  estimate  error  vectors  as 
ei  =  pi-tii  {i  =0,1,2) 
then  we  have 

#1  =  -4ti  -  4 
h  =  -x2'y2  -  x2d 
and 

«i  =  -'Pi  =  -k(sjst  -  ff,#,)  ( i  =  0, 1, 2) 

According  to  Eqs.  (11),  (15)  and  (16),  we  have 
*0  =  *o 

*i  =  *i  +  [o  (4)t]  =*i  +  [o  (#1  +  4)t] 


(15) 

E=^sJsi  +  YjJyJ  +  ^Ieiei 

(31) 

(16) 

Direct  computations  yield  that 

(17) 

so so  =  *J#o(*f  +  Ti)  -  Pos 0*0  +  *0 #0*0*0  +  sj d0 

(18) 

^  *0  ^2^®  e°^So  *1*1  +  ^Po 

(32) 

(19) 

*7*1  =  -*I*1*1  -  #l*f*l  +  *[#l(*2  +  y2)  +  *[rfl 

<  -*[(*!+#,)*  1  +  ||*,|[||#1|||fe  +  *|l|  +  ||«, ||  px 

(20) 

<  *[^ei  1  2  1  #> II2  —  */)*'  +  N2  +  W2  +  4/', 

(33) 

(21) 

S2S2  =  — *2 #2*2  -  #2*1*2  +  s\d2 

<  -*J#2*2  -  #2*1*2  +  IMIP2 

(22) 

2  1 

<  -*2*2*2  +  C2||*2||  +4P2 

(34) 

(23) 

4d  =  -y\  'ti  -  44  <  yJ  Q 1 4l  2  -  4)ti + * 

(35) 

(24) 

yjh  =  -ylx2ly2  -  ylx2  d  <  yj  Q  ||i2d||2  -  4 y2  +  ^ 

(36) 

*2  =  *2  +  *2c  =  *2  +y2  +  *2d 
Define 
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and 


=  -etsjsi  +  a  ant 
(i  =  0, 1 , 2) 


Then  we  have 

E  <  *o  j so  +  sf  Q  ||ft  ||2  -  fci  +  /3^ Si 

+  ^3  +  ^  ||i2c||2  -  -  ^S<T‘e*  +  C 


C=E  * 


(37) 


(38) 


(39) 


By  some  tedious  but  straightforward  calculations  (please 
see  Appendix  A),  we  have 

lift II  <  »?o(so,Si,ft,e0,*o,#  (40) 

||*fd||  <  ft(s0,si,ft,eo,*o,  A0,<Jo)  (41) 

||X2d||  <  >fe(So.*l>»2»J'l)J’2>eo,Ci,*0,*l,Tl,^0,0'0,At,ffi,^)  (42) 

where  »7o,ft  and  r\2  are  both  nonnegative  continuous  functions. 
Given  any  p  >  0,  the  set 

7?,  =  {[SJ  ST  ST  yJ  yT  e<)  ei  e2]T:£</,J 

is  compact  since  £  is  a  continuous  function  with  respect  to 
[sj  »f  sj  yj  yj  e0  ex  e2]  .  Hence,  the  set  B,  x  B2 
(the  direct  product21  of  Bt  and  B2)  is  also  compact.  Therefore, 
rj0,  r\ i  and  r\2  have  maximums,  say  M0,  M\  and  M2  on  Bx  x  B2. 
As  a  result,  we  have 

E  <  sj  QgJ  +  g0k0 j  s0  +  si  Q  Ml~ki+  h  j  Si  +  sj  (I3 
-  k2)s2+y\ ^/2  +  X-M\  -  r^ft 
+  yl (h  E^Ml-T^y,-1-  +  C  (43) 


If  the  design  parameters  are  selected  such  that 

'kSo+goko  <  ~ikIi 
\M\  —  kt  +  /3  <  -i jc/3 
/,  -  A,  <  -ix/3 

<  -|k/2 
/j  +  IM2-^1  <  -Ijc/3 

_  li  ft  5=  x 


(44) 


where  k  is  a  positive  real  number,  then  we  have 
E  <  —«:£'+  C  (45) 

If  E  =  p  and  k  >  C/p,  then  dE/dt  ^  0.  This  implies  that 
E(t)  <  p  for  all  t>  0  if  E(0)  ^  p.  By  comparison  principle,22 
it  is  easy  from  Eq.  (44)  to  obtain  that 

0  <  E{t)  <  ^  +  fj5(0)  exp(-Kf)  (46) 


Therefore,  s0,  *i,  s2,  ft,  y2,  e0,  ex  and  e2,  are  all  uniformly 
ultimately  bounded.  Furthermore,  x0,  jc  i  and  x2  are  all  uni¬ 
formly  ultimately  bounded.  In  addition,  it  is  easy  to  see  that 
for  given  au  C  is  a  constant  independent  of  k,  so  C/k  can  be 
made  arbitrarily  small  by  choosing  k  big  enough.  This  implies 
that  s0  and  si  can  be  made  arbitrarily  small  ultimately.  Hence, 
x0i,  X02  and  xu  can  be  made  arbitrarily  small  ultimately. 

To  sum  up,  we  have  the  following  theorem. 

Theorem  1.  For  the  uncertain  nonlinear  system  (10)  satisfying 
Assumptions  1-3,  the  robust  adaptive  dynamic  surface  control 
algorithm  (11)  with  appropriate  design  parameters  can  keep  all 
the  states  of  the  closed-loop  system  bounded  and  ultimately  drive 
the  partial  states  x0i,  x02  and  xu  into  a  neighborhood  of  zero 
whose  size  can  be  reduced  by  increasing  the  design  parameters  ky 
and  kiOj  and  reducing  the  design  parameters  Zy  at  the  same  time. 

Remark  3.  The  design  parameters  include  k0,  ku  k2,  zx,  z2,  Aq, 
Ai,  A2,  (T0,  (Ti  and  a2.  M0  depends  only  on  k0.  M\  depends  only 
on  k0,  A0  and  er0.  M2  depends  only  on  k0,  kx,  t t ,  A0,  A1;  (J0  and 
a i .  Hence,  according  to  Eq.  (44),  the  design  parameters  A0>  Ai, 
A2,  cto,  ci,  a2  and  k2  can  be  selected  easily;  but  for  the  design 
parameters  k0,  ku  t,  and  z2,  k0  should  be  selected  firstly,  then 
one  can  select  k\  and  zx,  and  further,  one  can  select  z2. 

Remark  4.  Similar  to  the  existing  literature  on  the  dynamic 
surface  control  method  (e.g.,  Refs.  1213,  etc.),  Theorem  1 
shows  the  existence  of  the  control  algorithm  to  ensure  the  sta¬ 
bility  of  the  closed-loop  system  but  does  not  provide  a  quanti¬ 
tative  criterion  on  how  to  select  the  design  parameters.  In  fact, 
it  is  very  difficult  to  give  such  a  criterion.  By  far,  the  design 
parameters  can  only  be  selected  by  trial  and  error. 

Remark  5.  Theoretically  speaking,  the  bigger  the  design 
parameters  ky  and  Ipj  are,  and  meanwhile  the  smaller  the 
design  parameters  zy  are,  the  smaller  the  ultimate  bounds  of 
the  states  x0i,  x02  and  xn  (i.e.,  i),  e  and  y)  will  be;  as  a  result, 
the  smaller  the  miss  distance  will  be.  However,  a  large  amount 
of  simulation  experiments  show  that  it  may  lead  to  unsatisfac¬ 
tory  or  even  unacceptable  transient  performance  of  the  closed- 
loop  system  if  the  dynamic  surface  gains  ky  are  selected  too  big 
and  the  filter  time  constants  Zy  are  selected  too  small.  For 
example,  the  transient  values  of  the  key  states  a.  and  p  may 
become  too  big  to  satisfy  the  practical  requirements.  There¬ 
fore,  the  design  parameters  should  be  adjusted  by  trading  off 
between  the  transient  performance  and  the  precision  of  the 
regulation. 


4.  Numerical  simulations 

In  this  section,  the  effectiveness  of  the  proposed  integrated 
missile  guidance  and  autopilot  algorithm  based  on  the  adap¬ 
tive  dynamic  surface  control  approach  is  verified  by  the 
6DOF  nonlinear  numerical  simulations. 

It  is  noted  that  system  (10)  is  only  used  for  the  integrated 
guidance  and  autopilot  design,  but  not  for  the  6DOF  nonlin¬ 
ear  numerical  simulations.  For  the  6DOF  nonlinear  numerical 
simulations,  the  original  nonlinear  motion  model  of  the  missile 
given  in  Ref.  17  is  adopted,  where  the  aerodynamic  forces  and 
moments  are  given  as  follows: 
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'  X  =  qS^  +  c>|  +  +  cf  xp.  +  <*\5X\  +  &\6,\  +  cj|<5z|) 

Y=qs(c*'x  +  cPfl  +  ciy*dz) 

Z  =  qs(c“a  +  cPj  +  cd/6y') 

Mx  =  qSL(mxa  +  mpJ  +  m6*8x) 

My  =  qSL(m^+mS/dy^ 

.  Mz  =  qSL(mla  +  ms/dz) 

(47) 

In  the  inertial  coordinate  system,  the  motion  model  of  the 
target  is  described  by 

{TVt  (48) 

l  vt  =  at 

where  xt  =  [xt  yt  zt]T,  V%  =  [Vlx  Vt},  VU]T  and 
at  =  [«t*  «t y  «tJT  are,  respectively,  the  position,  velocity 
and  acceleration  vectors  of  the  target. 

Define  xm  =  [xm  ym  zm]T  to  be  the  position  vector  of  the 
missile  in  the  inertial  coordinate  system,  then  the  states  R,  r, 
e  and  q  are  calculated  by 


IR  —  l/  (*t  —  -Xm)2  +  ( yt  —  ym)2  +  (zt  —  -m)2 

'•  =  \/ (Xt  -  Xmf  +  (Zt  -  Zm)2  (49) 

e  =  arctan  (ayil1) 
q  =  —  arctan 

The  initial  position,  the  initial  velocity  and  the  acceleration 
vectors  of  the  target  are,  respectively,  set  as 

fxt(0)  m  1 3000  0  300  ]Tm 
Ft(0)  =  [30  0  40]Tm/s 
*t  =  [4  0  3]Tm/s2 

For  the  missile,  the  initial  position  coordinate  vector  in  the 
inertial  coordinate  system  is  set  as 

xm(0)  =  [0  3000  0]Tm 


The  velocity,  the  pitch,  yaw  and  roll  angles,  the  flight  path 
and  heading  angles,  the  pitch,  yaw  and  roll  rates  at  initial  time 
are,  respectively,  set  as 

F(0)  =  200  m/s,  #(0)  =  0.02  rad,  i//(0)  =  0.01  rad 

y(0)  =  0  rad,  0(0)  =  0.01  rad,  i/v(0)  =  -0.01  rad 

t»*(0)  =0.1  rad/s,  t»,(0)  =  0.1  rad/s,  coz(0)  =  0.1  rad/s 

In  order  to  test  the  performance  of  the  proposed  integrated 
guidance  and  autopilot  algorithm  when  there  are  uncertainties 
in  the  missile-related  parameters,  two  hundred  times  of  Monte 
Carlo  simulation  experiments  are  done. 

Use  /V(0,1)  to  generate  a  number  from  a  normal  distribu¬ 
tion  with  mean  0  and  standard  deviation  1.  Based  on  this, 
we  define  TVt  as 

{-1  jA(0, 1)  <  —  1 

|  A(0, 1)  — 1  <  |A(0, 1)  <  1  (50) 

1  1A(0, 1)  >  1 

Remark  6.  NT  is  used  to  generate  a  random  number  in  the 
interval  [-1,  1].  It  is  noted  that  in  the  sequel,  for  each 
occurrence  of  NT,  it  almost  always  denotes  a  different  number. 

With  the  help  of  NT,  the  missile-related  parameters  used  in 
the  Monte  Carlo  simulation  experiments  are  given  in  Table  1. 

Remark  7.  For  the  formulas  of  the  parameters’  values  in 
Table  1,  the  numbers  before  the  brackets  denote  the  nominal 
values  of  these  parameters.  These  nominal  values  are  used  in 
the  integrated  guidance  and  autopilot  algorithm. 

The  main  requirements  for  the  present  design  are  as 
follows: 

(1)  the  miss  distance  is  no  greater  than  0.1  m. 

(2)  the  angles  of  attack  and  sideslip  are  both  no  greater  than 
8°. 

(3)  the  change  of  the  roll  angle  is  no  greater  than  1°. 

(4)  the  states  of  the  missile  are  bounded. 

(5)  the  above  four  requirements  are  satisfied  when  consider¬ 
ing  the  uncertainties  of  missile-related  parameters. 


Table  1  Missile-related  parameters. 


Name 

Value 

Name 

Value 

Name 

Value 

m 

1200(1  +  O.IJVt) 

raj8 

-27.31(1  +  0.2At) 

4* 

0.05(1  +  0.2At) 

P 

3500(1  +  0.1 VT) 

ms/ 

-26.57(1  +  0.2At) 

C* 

0.07(1  +  0.2At) 

Jx 

100(1  +  0. 1  At) 

ml* 

2.12(1  +  0.2At) 

4 

0.06(1  +  0,2At) 

Jy 

5700(1  +  0.1At) 

m« 

0.46(1  +  0.2At) 

4 

57.16(1  +  0.2At) 

Jz 

5600(1  +  0.1At) 

ml 

-0.37(1  +  0.2At) 

4 

5.74(1  +  0.2At) 

s 

0.42(1  +  O.IAt) 

Cx 0 

0.32(1  +  0.2At) 

cp 

-0.08(1  +  0.2At) 

L 

0.68(1  +  O.IAt) 

cj 

0.21(1  +  0.2At) 

cp 

-56.31(1  +  0.2AX) 

m* 

-28.16(1  +  0.2At) 

4 

0.19(1  +  0.2At) 

4 

-5.62(1  +  0.2At) 

m\- 

-27.92(1  +  0.2At) 

4? 

25.38(1  +  0.2At) 

4 

0.09(1  +  0.2At) 

«°ys)  ®  «°)/s) 
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f(s) 

Fig.  2  Curves  of  the  angles  a,  [i  and  y. 


Fig.  6  Curves  of  the  derivatives  of  >/  and  £. 


Fig.  3  Curves  of  angular  rates  cox,  <»y  and  wz. 


t(  s) 

Fig.  4  Curves  of  the  fin  deflections  dx,  5y  and  5Z. 


Fig.  7  Curves  of  pitch  angle  i). 


The  results  of  the  Monte  Carlo  simulation  experiments  are 
shown  in  Figs.  2-7.  The  mean  miss  distance  is  0.04  m  with 
standard  deviation  0.02  m.  This  means  that  the  missile  can 
intercept  the  maneuvering  targets  with  very  small  miss 
distance.  The  third  subfigure  of  Fig.  2  shows  that  the  roll 
angle  I  y  I  <  0.2°,  that  is,  the  change  of  the  roll  angle  can  be 
kept  near  zero  throughout  the  engagement.  Figs.  2,  3  and  6 
show  that  the  states  of  the  missile  are  bounded.  In  addition,  in 
the  Monte  Carlo  simulation  experiments,  the  uncertainties  of 
the  missile-related  parameters  have  been  fully  considered, 
hence  it  is  reasonable  to  say  that  the  proposed  integrated 
guidance  and  autopilot  is  robust  with  respect  to  the  inevitable 
uncertainties  existing  in  the  missile  dynamics.  These  imply  that 
the  design  objectives  of  the  integrated  guidance  and  autopilot 
system  are  achieved. 

Remark  8.  It  is  noted  that  in  Fig.  6,  the  derivatives  of  >]  and  e 
are  diverging.  This  is  consistent  with  the  reality  since  the  mis¬ 
sile-target  range  is  converging  to  zero  finally.  But  this  problem 
is  insignificant  since  the  integrated  guidance  and  control  sys¬ 
tem  will  stop  working  when  these  two  variables  become  big 
enough. 

Remark  9.  From  Figs.  2  and  7,  we  can  see  that  I  a  I  <5°, 

I  p  I  <5°  and  ■&  >  -40°.  It  is  easy  to  check  that 


Fig.  5  Trajectories  of  the  missile  and  the  target  (the  trajectory  of 
the  target  lies  on  the  x-z  plane). 


det(gi  ($,*i))  >  0 
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always  holds.  Hence,  gi(fl,Xi)  is  always  invertible. 

Remark  10.  It  should  be  pointed  out  that  it  is  assumed  in  this 
paper  that  the  angles  of  attack  and  sideslip  are  available  for  the 
integrated  guidance  and  autopilot  algorithm  design.  Although 
it  is  generally  difficult  to  measure  these  angles  directly  in  prac¬ 
tice,  there  already  exist  some  effective  methods  to  estimate 
them.  The  interested  readers  can  refer  to  Ref.  23  and  the  refer¬ 
ences  therein  for  detail. 

5.  Conclusions 

In  this  paper,  a  novel  fully  integrated  guidance  and  autopilot 
design  scheme  is  proposed  for  homing  missiles.  The  couplings 
between  the  guidance  system  and  the  autopilot  system  and 
those  between  different  channels  (i.e.,  the  roll,  the  yaw  and 
the  pitch  channels)  of  the  missile  dynamics  are  fully  and  explic¬ 
itly  considered  in  the  design  procedure.  The  proposed  inte¬ 
grated  guidance  and  autopilot  algorithm  is  based  on  a  new 
adaptive  block  dynamic  surface  control  method.  It  is  simple 
and  analytic,  and  can  avoid  complicated  computations  com¬ 
pared  to  the  existing  ones.  Also,  the  effectiveness  of  the  pro¬ 
posed  integrated  guidance  and  autopilot  algorithm  is 
demonstrated  by  the  6DOF  nonlinear  numerical  simulation 
results. 
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Appendix  A. 

First  of  all,  define  »/»(■)  and  »/•(■)  to  be  continuous  functions 
indexed  by 


According  to  Eq.  (21), 


*0  =  *0 

(A.1) 

then  from  Eq.  (11)  and  Assumptions  1  and  2,  we  have 

*fd  =  l*id#(*o,  co,  *o) 

(A.2) 

Then  from  Eqs.  (22)  and  (25),  one  c; 

in  obtain 

(A.3) 

Xt  = 

(A.4) 

Combining  Eq.  (13)  with  Eq.  (15),  it 

can  be  obtained  that 

*fc  =  -uVi 

(A.5) 

From  Eq.  (29)  and  Assumptions  1  and  2,  we  have 

IWI  <  th„(so,Si,Ti,eo,*o) 

(A.6) 

and 


INI  <  VSl^0,si,S2,yl,y2,e0,ei,ko,kU'&) 

Hence,  from  Eqs.  (A.l)  and  (A.6),  we  can  see 

(A.7) 

||*o|l  4  1IO(so,siJ„eo,*o) 

From  Eq.  (22),  we  have 

(A.8) 

*i=*i+[o  (±fc)T] 

(A.9) 

The  combination  of  Eq.  (A.9)  with  Eqs.  (A.5)  and  (A.7)  yields 

IINI  4  %,(so,«i,S2,J>i,Ti,eo,ei,*o,*i,ti,#) 
From  Eqs.  (12)  and  (17),  we  have 

(A.  10) 

k = Mr?* + °‘ei  -  wi) 

This  together  with  Assumption  1  yields 

(A.11) 

\k\  4 

From  Eq.  (11),  we  have 

xfi  =  -ffoHOOVo  +/o(*o))  +  *0*0 

(A.12) 

-  go  '  W  (Vo*o  +  H 0*0  +  lyj 

(A.  13) 

Hence,  it  is  easy  from  Eqs.  (A.l),  (A.6),  (A.8),  (A.12)  and 
Assumptions  1-2  to  obtain  the  inequality  (41). 

Further,  we  have 

IItiII  4  -u  Vi  -*fd 

(A.  14) 

From  (11),  (A.3)  and  (A.5)  and  Assumption  1,  w 

'e  have 

•*2d  =  gJlM{so,sl,yl,eo,ei,k0,kU'cU'&) 

Then  from  (23),  we  have 

(A.  15) 

*2  =  tfi2(*0,  *1 ,  *2,Ti  ,y2,  Co,  ei ,  *0,  *1 ,  Ti,  1?) 

(A.  16) 

Again,  from  Eqs.  (11)  and  (A.5),  we  have 

iM=  (%^  +  t -/(*>+  [i#]) 

-n^i  -£i*i  -|^*i  -  [T.y) 
(A- 17) 

Hence,  it  is  easy  from  Eqs.  (2),  (A.5),  (A.  10),  (A.  12),  (A.  14), 
(A. 16)  and  (A. 17)  to  obtain  the  inequality  (42). 

In  addition  it  is  easy  from  Eq.  (A. 3)  to  obtain  the  inequality 
(40). 
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